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This  final  report  for  USARO  20 1 25EG/DAAG29-83-K01 44 ,  titled 
"Configuration  Synthesis  and  Approximate  Motion  Programming  of  Robot 
Manipulators,"  briefly  describes  the  research  work  done  during  the  period  from 
October  l,  1983  to  September  30,  1986.  Specific  details  of  the  research 
performed  can  be  found  in  the  published,  or  soon  to  be  published,  technical 
papers;  the  Army  Research  Office  has  already  been  provided  with  the  copies  of 


these  papers. 


Statement  of  Problems  Studied 

I.  Rationalize  the  process  of  synthesizing  and  ev  .rating  robot  arms  and 
wrists . 

11.  Develop  a  simple  method  for  representing,  and  analyzing  the  kinematics 
and  dynamics  of  robot  manipulators. 

III.  Develop  approximate  manipulation  strategies  for  robots  which  are  not 
computationally  intensive. 

I.  Configuration  Synthesis  of  Robot  Arms 

Configuration  synthesis  deals  with  the  rational  process  of  determining 
geometrical  parar -,-ters  of  a  robot  arm  including  those  of  the  wrist  in  order  to 
achieve  certain  performance  charueterist ics .  This  research  has  developed  the 
workspace  analysis  into  a  unifying  tool  for  configuration  synthesis.  Tnis  is 
a  departure  from  the  traditional  interpretation  of  the  workspace  ir  which  only 
its  volumetric  aspects  are  considered  to  be  significant.  We  have  shown1  that 
the  workspace  can  be  used  to  determine  dexterity,  joint  solution  space,  singu¬ 
lar  surfaces  in  the  workspace,  and  transformation  characteristics  of  various 
kinds  of  empty  spaces  (aoles,  central  voids,  toroidal  voids).  The  condition 
for  optimum  dexterity  of  anlhrophomorphic  robot  structure  has  been  shown  to 
be  that  the  distances  bet  en  the  shoulder  and  elbow,  elbow  and  wrist,  and 
wrist  and  tool  tip  be  equal. 

Robot  wrist  structures  which  are  k i nemat i cal  1 y  equivalent  to  spherical 
wrists  are  commonly  used.  The  problem  of  tool  spin  with  r.  spect  to  various 
axes  passing  through  the  spherical  wrist  center  has  been  investigated.  This 
problem  arises  because  a  tool  mount  is  often  used  to  mount  the  tool  on  the 
end-effector ,  and  simple  rotations  about  the  i o;  iponent  joint  axes  of  the 
wrist  are  not  sufficient  for  many  tasks;  rather,  coordinated  joint  rotations 

^.C.  Gupta,"  On  the  Mature  of  Robot  Workspace,"  Israel  Journal  ot  iiohaelogv 
22:  71-79  ,  1984/5;  International  Journal  of  Robotics  Research  5(..l):  117-121 
1986  (revised). 


axes  passing  through  the  spherical  wrist  center  has  been  investigated.  This 

problem  arises  ecause  a  tool  mount  is  often  used  to  mount  the  tool  on  the 

end-effector,  and  simple  rotations  about  the  component  joint  axes  of  the  wrist 

are  not  sufficient  for  many  tasks;  ra  her,  coordinated  joint  rotations  at  the 

wrist  axes  must  be  considered  to  induce  effective  rotation  of  the  tool  about 

certain  axes  passing  through  the  spherical  wrist  center.  But  this  is  not 

possible  in  gen *ral ,  and  rigorous  conditions  for  the  wrist  and  tool  mount 
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parameters  have  been  derived  to  insure-  the  spin  of  the  tool  about  certain 
axes,  as  well  as  about  arbitrary  axes,  passing  through  the  wrist  center. 

1 1 .  7.  or  o  R  efe_r  enc  e  Pos  ition  Method 

A  simpl  fled  method  for  representing  and  analyzing  robots  has  been 
developed.  This  method,  called  the  zero  reference  position  method,  can  be 
learned  easily.  Engineers  without  an  extensive  background  in  advanced 
kinematics  can  become  proficient  in  using  this  method  in  a  short  time;  this  is 
a  very  attractive  feature  because  robotic  system  development  is  an 
interdisciplinary  activity  which  dra-s  engineers  and  scientists  from  various 
technical  backgrounds .  The  zero  reference  position  description  is  in  terms  of 
the  joint  axes  directions  and  locations  in  a  suitably  chosen  position  of  the 
robot  where  all  of  the  joint  variables  are  defined  to  have  zero  values.  The 
governing  kinematic  equations  of  the  robot  are  derived  from  this  data  by 
opplying  an  important,  but  often  neglected,  principle  of  displacement 
similarity.  This  leads  to  an  explicit  and  efficient  method  for  kinematic 

'  K  .  t  .  i.'upt.i,  "Rotatahi  1  i  ty  ('on--  ider.it  ions  1  or  Splx-ric.il  1  our  Bar  I  ink  i.  us  with 
\pp  1  i  at  inns  to  Robot  Wiist  Design,"  ASME  k"im  1  <>!  Mi  •  h  in  i  x:r.s  ,  ,  ran.oo  i  -  s  i  on 

,tid  Aut.>-  it  ion  in  Design,  108:  387-391,  I98o. 


analysis  .  A  quantitative  comparison  of  this  method  with  the  implicit  and 
less  efficient  method  of  Vukabratovi c ,  Suh ,  Radcliffe,  et.  al.  has  been 
developed.  Engineers  who  are  well  versed  with  the  method  of  Pieper-Roth, 
which  is  based  upon  DH  representation,  will  also  appreciate  the  simplicity  and 
directness  of  the  zero  reference  position  method;  at  the  very  least,  it  can  be 
used  as  an  independent  method  to  verify  the  complicated  derivations  of 
equations . 

4 

A  small  catalog  of  closed -form  solutions  using  the  zero  reference 

position  method  his  be*  n  developed.  The  following  list  indicates  the  variety 

of  industrial  robots  which  have  been  considered. 

4 

Cartesian  robot  with  3  roll  wrist 

4 

Cylindrical  robot  with  3  roll  wrist 

4 

Spherical  robot  with  3  roll  wrist 
4 

Stanford  Arm 

4 

SM  229  robot 
PUMA4 

Bendix  robot^ 

C i nc i nna t i -Mi  1 ac ron  T3^ 

A  recently  developed  three-roll  wrist  design  is  based  upon  the  principle  of 

differential  type  bevel  geared  trains.  Such  a  wrist  leads  to  a  compact  and 

sturdy  wrist  design  and  it  also  reduces  the  mass  which  is  far  from  the  base 

column.  Closed-form  kinematic  solutions  for  robots  with  geared  three-roll 

4 

wrists  has  been  developed  so  that  these  robots  can  be  controlled  by  computers. 


K .  .  '•Mptu  and  C.  T.  Carlson,  "On  Certain  A--;  tuts  of  the  Zt  ro  Reference  Position 

•  :  1  >;id  Its  A  |  pi  i.  at  i  o;is  to  an  Industrial  v  t:  i  pu  1  a  t  or  ,  "  i’  roc  .  I  .  t  t  t  font. 

'■  •  ■  ’  !•••  a  !  \ut  t  i  ■  -n ,  2:  },  iu.Sh  (.  o  i.iiMil);  ,’ouinal  of  K  v  air  5y.-- 

ill)!  •  1  -  i  f  ,  1  )  Ab  ita  v  i  si  d  )  . 

h"  ■ 1  •  •  i '  a  ,  f  i  •‘..(f  i  <  Analysis,  o  t  M  i  a  i  j  t :  h  1 1  o  r  s  Using,  the  Zero  Rt  I  <,  r  t  .  *  e  Pe  s  i  - 
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Closed-form  analytical  solutions  can  be  derived  for  most  Industrial 


robots.  However,  iterative  techniques  are  useful  when  the  clo' rd-form 
solution  Is  not  readily  available,  or  a  general  purpose  robot  motion  analysis 
software  is  to  be  developed  for  these  situations.  A  robust  algorithm  for 
numerical  Inverse  kinematics  has  been  developed  .  This  algorithm  exploits 
«ome  important  features  of  rohot  kinematics  to  develop  a  special  variable  step 
predictor-corrector  scheme  for  integrating  the  velocity  equations  of  the 
robot.  It  has  been  shown  to  be  reliable,  stable  and  efficient.  The  problems 
of  unpredictable  and  unexplainable  divergence,  which  plague  ordinary  numerical 
schemes  for  inverse  kinematics,  have  been  eliminated.  This  algorithm  can  also 
converge  at  those  positions  of  the  robot  which  are  almost  si ngul ar--ord 1  nary 
algorithms  for  inverse  kinematics  start  misbehaving  when  joint  angles  have 
values  within  5°-10°  of  their  singular  values.  A  robust  algorithm  for 
numerical  inverse  kinematics  is  an  important  first  step  in  developing  a 
general  purpose  robot  controller.  A  subsequent  modification  of  this 
algorithm"7  has  improved  its  time  efficiency  considerably.  This  algorithm 
replaces  all  rotation  matrix  related  operations  with  their  vector  equivalents 
bv  using  the  F.uler  parameters.  Other  changes  which  are  considered  minor 
Improve  the  linear  equation  system  solver,  the  computation  of  the  rotational 
deviation  errors,  and  the  pred i r t or-cor rec t or  iteration  logic. 


The  zero  reference  position  method  has  also  been  extended  to  the  domain 
R 

of  manipulator  dynamics  .  The  additional  data  concerning  the  dynamic 

■  ..upt.i  .1.;.!  r  h  i/...  roan  i  .in  ,  "l.vp!  .'Ved  bur*  t  ic  st  t.t  i<e;>  .  :  invt  I  .•  »  *  l  ■ ..  • 

n  it  Us  el  Robots,"  i’roc  .  iii.l  i  on*  .  Robot  i  <  s  and  An  ton.,  it  ion  io-i-nb  i  <',•>  > . 

h  .  -upt  a  and  V .  K  .  Singh,  "A  Nunn  lit  il  A I  t’.o  r  i  t  hi;,  tor  Solving  Robot  invert, 


properties  of  the  manipulator  is  defined  in  the  zero  reference  position.  This 
includes  the  body  vectors  from  the  joints  on  a  link  to  the  mass  center  of  the 
link,  weights  of  the  links,  and  the  inertia  matrices  for  the  links  with 
respected  to  the  translated  base  coordinate  system  located  at  the  link  centers 
of  masses.  For  the  inverse  dynamic  problem,  the  motion  of  the  end-effector 
and  the  forces  acting  on  it  are  known,  and  we  need  to  compute  the  joint 
torques  which  are  needed  to  drive  the  manipulator.  A  recursive  Newton-Euler 
formulation  has  been  developed  by  considering  the  equations  of  dynamic 
equilibrium  for  each  link.  Two  key  observations  are  that  the  forms  of  the 
generalized  Euler  equations  in  the  centroidal  body  system  and  the  translated 
base  system  are  similar,  although  the  inertia  matrix  in  the  latter  case  is 
time  varving;  and  that  an  appropriate  link  related  transformation  of  all 
vector  quantities  as  well  as  the  inertia  matrix  reduces  the  number  of  matrix 
calculations  significantly.  The  computational  complexity  analysis  of  this 
approach  shows  that  it  compares  favorably  with  other  approaches  for  joint 
force/torque  computations. 

g 

In  manipulator  simulation  ,  the  joint  f orces/ torques  are  given  and  the 
motion  of  the  robot  needs  to  be  determined.  For  this  problem,  the  above 
mentioned  recursive  Newton-Euler  formulation  is  appropriately  revised  to 
numoricallv  set  up  the  state  equations  of  the  manipulator;  the  state  variable 
vector  consists  of  the  joint  variable  values  and  the  joint  velocities.  In 
particular,  the  coefficients  of  the  governing  system  of  nonlinear  and  ordinarv 
differential  equations  are  not  determined  explicitly.  Rather,  assuming  that 


K.  K  ici  rotini  ,1:1  and  K.C.  Gupta ,  "Manipulator  Dynamics  I'sing  the  Extended  Zero 
Reference  Position  Description,"  Proc.  9th  Applied  Mechanisms  Coni".  2:  6.1-b.ll, 
I9RS;  li.EK  Journal  of  Robotics  and  Automation  2(4);  221-224  ,  198b  (.revised). 


the  current  state  (joint  values  and  velocities)  of  the  manipulator  is  known, 
the  recursive  Newton-Euler  equations  are  manipulated  algebraically  to 
calculate  the  rates  of  the  state  variables--this  numerical  set  up  is  precisely 
what  is  needed  for  the  numerical  integration  of  the  dynamics  equations  for 
which  a  predictor-corrector  method  has  been  used. 

III.  Approximate  Mani pul  at i on  of  Robots 

An  important  requirement  for  the  design  of  an  autonomous  robotic  system 

is  that  it  be  able  to  do  trajectory  planning  and  perform  the  related  inverse 

kinematics  and  inverse  dynamics  calculations  in  real-time  using  a  small 

on-board  computer.  However,  these  computations  are  well  beyond  the  real-time 

computing  capabilities  of  small  computers.  Therefore,  alternate  manipulation 

strategies  must  he  developed  which  are  not  so  compu t at i ona 1 1 v  intensive.  This 

research  has  developed  one  approach  to  this  problem.  A  strategy  has  been 

developed  which  is  based  upon  the  idea  of  the  end-effector  being  attracted  by 

9 

a  hypothetical  goal  which  is  either  stationary  ,  or  moving  along  a  prescribed 
trajectory^.  A  three  part  force-couple  system  is  synthesized  to  move  the 
end-effector  toward  the  hypothetical  goal,  to  slow  down  the  end-effector  if 
its  speed  becomes  excessive,  and  to  direct  it  toward  the  prescribed  trajectory 
if  the  end-effector  tends  to  drift  off  course.  Further  adjustments  are 
necessary  to  improve  the  accuracy  and  to  avoid  sudden  changes  in  the 
synthesized  force-couple  system.  A  Jacobian  transformation  is  used  to  convert 
this  force-couple  system  at  the  end-effector  into  the  joint  torques  which  are 

k.  k.ir.t  r.-.m  i.m  am  .  t’.i  .  . ,  "A  lar.a  t  I  rs.  i-  in,-  Mat.ipul.it  ion  Theory  tor 

Robots,"  •  rot  .  btii  IAS  I  ill)  Symposium  on  Robot  its  and  Automat  ion ,  lc<8r>;  IASJI.J 
Journal  o!  Robotics  and  Autonation  1(3):  xxx,  198b  (to  appear). 

'  V.J.  Carlson  ami  k.C.  Cupta,  "A  Strategy  for  Approximate  Manipulation  of 
Robots 1'rot.  ASM!  Computers  in  engineering.  Conf  .  1:  87-94 ,  1986. 


required  to  drive  the  manipulator;  gravity  and  static  payload  effects  are  also 
compensated.  This  computation  requires  only  the  multiplication  of  the  6x6 
transposed  Jacobian  matrix  with  a  6x1  column  vector  of  the  end-effector 
force-couple  system;  in  particular,  inversion  of  Jacobian  matrix  is  not 
necessary.  When  this  approximate  manipulation  strategy  was  evaluated  by  using 
numerical  simulation,  it  was  found  to  be  reasonably  accurate  for  gross  motions 


of  the  robot  arm. 
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